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摘 要 : 


[目的 /意义 ] 农机 装备 太 十 大、 行驶 慢 等 特点 ， 在 路 面 归 库 作业 过 程 中 容易 造成 严重 道路 拥堵 。 因 此 ， 


在 多 机 协同 过 程 中 ， 编 队 行 驶 被 认为 是 未 来 道路 上 行驶 的 主要 方式 。 然 而 ， 目 前 农机 自动 驾驶 技术 停留 在 单机 阶 


受 ， 多 农机 之 间 的 协同 仍 是 制约 中 国 农业 规模 化 自主 4 


E 产 的 主要 瓶 贷 。 为 解决 多 车 编队 协同 控制 中 通信 延 时 的 问 


题 及 其 补偿 策略 ， 本 人 研究 基于 一 种 模型 预测 控制 器 (Model Predictive Control, MPC) 延 时 补偿 器 的 农机 多 机 编队 行 
强 的 轨迹 跟踪 方法 。[ 方 法 ] 以 车 联网 技术 为 基础 ， 聚 焦 多 农机 编队 协同 控制 领域 ， 针 对 控制 器 局 域 网 总 线 (Con- 
troller Area Network, CAN). 通信 存在 的 延 时 间 题 而 产生 的 横向 控制 精度 差 ， 基 于 线性 二 次 调节 器 (Linear Quadratic 


Regulator, LOR) 与 MPC 算 法 ， 设 计 了 一 种 带 有 延 时 补偿 的 模型 预测 控制 器 ， 用 于 对 通信 延 时 进行 补偿 控制 。 最 后 


对 所 提 算 法 利 


度 误差 曲线 响应 更 快 ， 


] Carsim FI Simulink 软件 进行 联合 仿真 。[ 结 果 和 讨论 ] Carsim 与 MATLAB/Simulink 可 以 有 效 兼容 ， 
实现 软件 与 外 部 求解 器 的 联合 仿真 。 当 延 时 步 长 4=5 时 ， 应 
能 够 逐渐 稳定 至 零 误 差 ， 没 有 出 现 振 荡 现 象 ; 1 号 车 在 较 短 时 间 内 有 效 地 变更 车 道 ， 与 


j 延 时 补偿 ，MPC 反 应 速度 更 快 ， 表 现 更 为 平滑 ; 速 


头 车 保持 在 同一 车 道上 。 在 更 长 的 延 时 步 长 4=10 情 况 下 ， 未 应 用 延 时 补偿 的 控制 器 表现 出 更 显著 的 性 能 下 降 。 即 
使 在 较 高 的 延 时 条 件 下 ， 应 用 延 时 补偿 的 MPC 速度 误差 和 纵向 加 速度 仍然 能 够 快速 响应 并 逐渐 稳定 至 零 误 差 ， 避 
免 了 振荡 现象 。1 号 车 的 轨迹 表明 ， 延 时 补偿 机 制 效果 在 极端 延 时 条 件 下 有 所 下 降 。[ 结 论 ] 本 研究 所 设计 的 编队 
算法 能 够 使 得 多 车 完成 多 车 变 道 形成 队列 并 保持 一 定 距离 和 一 定 速 度 。 通 信 延 时 补偿 控制 算法 使 得 带 有 加 入 延 时 
的 车 辆 能 较 好 完成 编队 任务 ， 实 现 稳 定 的 横 纵 向 控制 ， 验 证 了 本 人 研究 带 有 延 时 补偿 的 模型 预测 控制 占 的 可 行 性 。 
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随 着 人 口 老 龄 化 、 社 会 城镇 化 ， 以 及 青 壮 年 就 
业 观 念 的 转变 "2， 促 生 了 农业 机 械 装 备 发 展 趋向 
于 智能 化 、 自 动 化 和 无 人 化 。 面 对 农田 大 规模 ， 单 
机 作业 时 间 长 、 效 率 慢 ， 农 机 自动 驾驶 协同 技术 成 
为 了 解决 农业 规模 化 、 集 约 化 和 专业 化 发 展 的 核心 
之 一 Pa。 农 机 装备 尺寸 大 、 行 驶 慢 等 特点 ， 在 路 
面 归 库 作业 过 程 中 容易 造成 严重 道路 拥堵 。 因 此 ， 
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在 多 机 协同 过 程 中 ， 编 队 行 驶 被 认为 是 未 来 道路 上 
行驶 的 主要 方式 “。 这 一 技术 允许 分 散在 多 条 车 道 
上 的 单机 通过 先进 的 车 联网 技术 (Vehicle to Every- 
thing, V2X) 通信 技术 进行 协同 控制 ， 形 成 柔性 车 
队 “， 从 而 能 够 节约 车 道 资源 、 缩 小 农机 间距 、 组 
解 交 通 拥堵 、 降 低 驾 驶 员 操 纵 失 误 而 引发 的 交通 
事故 。 

在 多 车 编队 控制 研究 中 ，Gu 等 ”针对 水 面 车 
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辆 编队 形式 的 问题 ， 提 出 了 一 种 针对 一 组 前 驱动 自 
主 水 面 车 辆 的 路 径 引 导 时 变 编队 制导 律 设 计 ， 同 时 
避免 车 辆 之 间 的 碰撞 。Guan 等 e 提出 了 基于 物 联 
网 平台 的 机 器 人 编队 控制 ， 基 于 物 联 网 平台 构建 了 
机 器 人 协作 运动 控制 实时 传输 系统 ， 采 集 并 反 锯 多 
台 机 器 人 的 运动 轨迹 。 通 过 粒子 群 优化 深度 学 习 算 
法 ， 更 准确 地 识别 、 预 测 和 指导 机 器 人 的 下 一 步 动 
作 。Ding 等 ”克服 了 单一 视觉 传感器 系统 的 局 限 ， 
使 用 深度 相机 作为 信息 感知 源 。 在 负 梯 度 控制 律 的 
基础 上 ， 将 约束 条 件 融入 机 器 人 控制 器 的 设计 中 。 
经 过 图 像 采集 和 图 像 处 理 后 ， 外 部 环境 信息 和 障碍 
物 位 置信 号 输入 到 领导 者 的 控制 系统 中 。Pan 等" 
研究 了 3D 受 限 空间 中 多 架 无 人 机 (Multi-UAV) 的 
路 径 规划 和 编队 控制 问题 。 考 虑 人 工 势 函数 的 局 部 
最 小 值 ， 针 对 多 机 系统 提出 了 一 种 基于 改进 和 人工 势 
函数 的 有 效 路 径 规 划 方 法 。Obradov 运 等 提出 了 
一 种 基于 强化 学 习 算 法 的 分 散 领 导 者 -跟随 者 编队 
控制 的 分 散 算 法 ,通过 分 解 为 两 个 更 简单 的 任务 ， 
能 够 使 用 简单 的 基于 学 习 的 方法 在 接近 阶段 实现 机 
器 人 的 安全 导航 以 及 精确 一 致 的 位 置 保持 。 

目前 ， 现 有 的 多 机 编队 协同 控制 多 集中 运用 运 
动 学 模型 ” ， 旨 在 简化 模型 起 到 快速 计算 的 作用 。 
然而 农机 装备 结构 复杂 ， 单 纯利 用 运动 学 模型 无 法 
实现 高 精度 编队 作业 。 此 外 ， 理 想 化 的 控制 方法 没 
有 考虑 CAN 通 信 延 时 的 影响 。 尽 管 上 述 研究 为 多 
车 编队 协同 控制 提供 了 理论 基础 和 技术 框架 ， 但 它 
们 大 多 忽略 了 通信 延 时 这 一 关键 技术 挑战 。 由 于 
CAN (Controller Area Network) 通信 系统 在 农业 机 
械 领 域内 的 广泛 应 用 ， 特 别 是 在 多 机 编队 协同 控制 
中 ， 通 信 延 时 间 题 对 作业 的 实时 性 和 准确 性 提出 了 
更 高 的 要 求 。 在 横向 控制 精度 上， 通信 延 时 可 能 
致 车 辆 无 法 精确 地 保持 在 预定 路 径 上 ， 从 而 影响 整 
体 的 作业 精度 和 安全 性 中。 这 种 横向 控制 差 不 仅 
会 增加 作业 过 程 中 的 重复 性 ， 还 可 能 导致 在 复杂 的 
农业 环境 中 车 辆 出 现 偏离 轨道 的 情况 ， 从 而 提高 了 
作业 风险 ， 降低 了 作业 效率 US, 

本 研究 提出 采用 模型 预测 控制 (Model Predic- 
tive Control, MPC) 技术 优化 多 车 编队 协同 控制 ， 
利用 其 强大 的 数据 处 理 和 实时 反馈 能 力 来 补偿 通信 
延 时 带 来 的 影响 。MPC 通 过 预测 未 来 的 系统 状态 
和 控制 行为 ， 减 少 通信 延 时 对 编队 控制 精确 性 的 影 
Wu, ACRE BASIE BY TA] LE BE o 

本 人 研究 基于 车 辆 动力 学 模型 和 MPC 技 术 ， 探 
讨 多 车 编队 协同 控制 中 通信 延 时 的 问题 及 其 补偿 策 


略 ， 并 通过 Carsim FI Simulink 的 融合 仿真 来 验证 所 
提 方 法 的 有 效 性 ， 以 实现 提升 交通 安全 和 道路 通行 
效率 、 节 省 燃油 消耗 等 目的 。 


1 农机 多 机 编队 协同 的 控制 策略 设计 
1.1 多 机 编队 协同 场景 描述 


本 研究 所 考虑 的 场景 是 4 辆 农机 装备 行驶 在 3 
条 车 道上 ， 基 于 多 机 协同 使 4 辆 初速 度 不 同 的 农机 
组 合成 同一 编队 ,使 其 四 者 之 间 按 某 一 速度 均匀 行 
JR, 最终 以 达到 编队 内 农机 距离 、 速 度 保持 一 致 ， 
其 初始 状态 机 最 终 状 态 分 别 如 图 1 和 图 2 所 示 。 在 
节约 道路 资源 的 同时 ， 起 到 提升 道路 通行 率 、 减 少 
能 源 消耗 “。 在 道路 坐标 系 中 ，4 辆 农机 装备 的 初 
始 质 心 坐标 及 速度 如 表 1 所 示 。 


图 1 农机 编队 协同 行驶 初始 状态 示意 图 
Fig. 1 Initial state schematic diagram of agricultural machinery 


convoy cooperative driving 


a. 最 终 状态 示意 图 (俯视 图 ) 


b. 最 终 状 态 示意 图 ( 侧 视图 ) 


图 2 农机 编队 协同 行驶 最 终 状 态 示意 图 


Fig. 2 Final state schematic diagram of agricultural machinery 


convoy cooperative driving 


1.2 多 机 编队 协同 架构 


1.2.1 车 联网 技术 
V2X e 是 一 种 全 方位 通信 技术 ， 集 成 了 车 辆 
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表 1 农机 编队 初始 状态 参数 
Table 1 Initial state parameters of agricultural machinery in for- 


mation form 


参数 符号 物理 意义 数值 
Xoo 头 车 初始 位 置 (50,6) 
Voo 头 车 初速 度 /(m/s) 12 
Xio 1 号 车 初始 位 置 (40,10) 
Vio 1 号 车 初速 度 /(m/s) 14 
is 2 号 车 初始 位 置 (20,2) 
V9 2 号 车 初速 度 /(m/s) 16 
eg 3 号 车 初始 位 置 (1,6) 
V3 3 号 车 初速 度 /(m/s) 15 


与 车 辆 (Vehicle to Vehicle, V2V) ^^". zt Eit 
(Vehicle to Infrastructure, V21) ?^?' . 4f 55 pj 2& 
(Vehicle to Network, V2N) >, DL "E MSTA 
(Vehicle to Pedestrian, V2P) ‘°° 4 种 通信 方式 ， 用 
于 车 辆 与 周边 网 络 信 息 环 境 的 通信 ， 其 目标 是 通过 
融合 技术 构建 交通 环境 中 各 个 实体 之 间 的 信息 交互 
网 络 ， 实 现 车 辆 与 其 他 交通 参与 者 或 基础 设施 之 间 
的 数据 交互 和 共享  ， 同 时 建立 实时 可 靠 的 通信 
网 络 ， 使 车 辆 、 道 路 和 云 结构 的 数据 能 够 有 效 相互 
利用 。 

1.2.2 ”架构 设计 

由 于 单机 感知 技术 受到 环境 、 光 照 等 影响 存在 
误差 ， 为 增强 编队 中 多 机 协同 的 安全 性 ， 编 队 车 辆 
需要 将 车 身 传 感 右 获取 的 信息 基于 V2X 通 信 传 输 至 
路 测 单元 (Road Side Unit, RSU)， 并 通过 路 测 单 元 
将 编队 中 各 个 车 辆 位 置 、 速 度 、 加 速度 等 信息 传输 
TA", 

如 图 3 所 示 ， 本 研究 采用 基于 V2X 通 信 技 术 的 
系统 来 集中 处 理 车 队 中 各 车 辆 的 传感器 数据 。 这 些 
数据 包括 每 辆 车 的 位 置 、 速 度 和 加 速度 等 信息 。 这 
些 信息 首先 被 传送 到 RSU， 在 那里 进行 综合 处 理 。 
处 理 后 的 数据 ， 包 括 各 和 车辆 的 期 望 速 度 和 位 姿 ， 被 
发 送 回 车 队 中 的 每 辆 车 。 随 后 ， 每 辆 车 通过 CAN 
总 线 将 这 些 信息 传 送 至 其 控制 器 和 执行 器 O, MA 
而 实现 对 预定 轨迹 和 位 姿 的 精确 跟踪 控制 。 


2 农机 运动 学 和 动力 学 模型 建立 
2.1 农机 运动 学 模型 


本 研究 基于 二 自由 度 的 车 辆 运动 学 模型 构建 了 
农机 模型 。 在 此 模型 中 ， 忽 略 了 农机 在 转弯 过 程 中 
前 轮 左右 两 侧 轮胎 的 侧 偏 角 差 值 "”。 在 行驶 时 ， 


路 测 通信 单元 (RSU) | 
引 | 


车 载 通信 单元 


FTT 3 


eae 


图 3 基于 车 联网 技术 的 多 车 协同 控制 框架 
Fig. 3 Multi-vehicle cooperative control framework based on 


vehicle to everything 


前 轮 的 转向 角度 保持 在 一 个 预定 的 范围 内 ， 而 车 轮 
在 转弯 时 产生 的 侧 向 力 与 侧 偏 角 成 正比 关系 。 基 于 
这 些 假设 ， 将 所 研究 的 农机 模型 简化 为 一 个 自行 车 
模型 ， 如 图 4 所 示 。 


4 
oa LAP = 

注 : 在 道路 坐标 系 下 , La AERE; 9 为 航向 角 ; 为 汽车 质 
心 的 侧 偏 角 ; B, B, TA A EU DR B. ,表示 轮子 速度 和 轮子 朝向 
的 夹 角 ; 6 为 前 轮转 角 ; mw, 表示 横 摆 角速度 ; 》 为 质心 侧 向 速度 这 为 
质心 纵向 速度 ; Fu、Fw 分 别 为 前 后 轮 在 X 方 向 受到 的 力 ; 已 FLA 
别 为 前 轮 和 后 轮 侧 向 力 。 

EA 农机 模型 简化 的 自行 车 模型 
Fig. 4 Simplified model of agricultural machinery to 


bicycle model 


在 道路 坐标 系 中 ， 当 (x,，y) 为 前 轴 中 心 坐 标 ， 
前 轴 速 度 为 w 时 ， 根 据 运动 学 公式 得 到 车 辆 运动 学 
方程 ， 矩 阵 形式 如 公式 (1) 所 示 。 


X v,COS 
J |=] vsing (1) 
9 w 


由 牛顿 定律 得 到 车 辆 模型 微分 方程 公式 (2)。 

m(}+%0,) = Fy + F,, (2) 

Io,-lF,-LF, 

式 中 : m 为 车 的 质量 ，kg; 7. 为 车辆 转动 惯量 ， 
kg:m^; yy 和 五 ,分 别 为 前 后 轮 在 y 方 向 受到 
的 力 ，N。 


72 智慧 农业 (中 英文 ) Smart Agriculture 


Vol. 6,No. 3 


在 车 辆 稳 态 转向 下 本 研究 基于 自行 车 模型 来 推 
导 前 轮 前 馈 转 角 67， 以 固定 转向 角 和 恒定 速度 行 
驶 ， 下 面 用 几何 关系 来 推导 车 辆 稳 态 转向 方程 ， 车 
辆 稳 态 转向 如 图 5 所 示 ， 其 中 c.g 点 为 车 辆 的 质心 ; 
1= i+ 1,， 为 轮 距 。 


4 


y 


图 5 农机 稳 态 转向 模型 
Fig.5 Steady-state steering model of agricultural 


machinery model 


车 辆 转弯 半径 R > 1, afb, Wasi, T 


以 得 到 a = 6 -p+ B,, 进而 可 以 推出 转角 5， 如 公 
st (3) Bn. 


1 
à t5, (3) 


由 上 述 条 件 可 知 ， 前 轮 和 后 轮 的 侧 偏 角 很 小 ， 
而 作用 于 轮子 的 侧 向 力 正比 于 对 应 的 侧 偏 角 度 ， 如 
公式 (4) 所 示 。 

Fy, =—2c,B, 

F, =-2c,p, 

AS df Bel v FE [oy] AIL CAR, MAO WTA, 该 
车 辆 运动 学 模型 经 过 整理 如 公式 (5) 所 示 。 


2 


(4) 


R 
图 6 阿 克 曼 转 向 系 模型 


Fig. 6 Ackermann steering system model 


i id 
y = Sng Ve (5 ) 
ó tanó 

L 


2.2 农机 动力 学 模型 


基于 物体 运动 与 力学 之 间 的 关系 ， 为 实现 高 精 
度 轨迹 跟踪 以 及 和 鲁 棒 性 控制 稳定 性 ， 建 立 农机 动力 
学 模型 ““。 以 运动 学 模型 为 基础 ， 增 加 农机 运动 
过 程 中 侧 向 力 等 约束 ， 建 立 如 图 7 所 示 的 农机 动力 


学 模型 。 


0 E 
图 7 基于 自行 车 模型 的 农机 单车 动力 学 模型 


Fig.7 Agricultural machinery dynamics model built in this re- 


search based on bicycle model 


假定 如 下 条 件 。 

1) 车 辆 的 重量 不 变 ， 始 终 在 重心 上 ; 

2) 车 辆 行驶 在 平坦 的 直道 上 ， 且 没有 垂 向 
运动 ; 

3) 忽略 车 辆 受到 的 空气 阻力 。 

在 道路 坐标 系 中 ，F, 和 五 ,分 别 为 前 后 轮 在 x 方 
向 受到 的 力 N; Fy 和 ,分 别 为 前 后 轮 在 y 方 向 受 
到 的 力 ，N; x 为 汽车 在 纵向 上 的 速度 ，m/s; x 为 
汽车 在 纵向 上 的 加 速度 ，m/s”; y 为 汽车 在 横向 上 
的 速度 ，m/s; 4 和 1 分 别 为 汽车 的 前 后 轴 距 ，m， 
其 和 为 站; 9 为 汽车 在 全 局 坐标 系 下 的 航向 角 ， 
rad; 0 为 汽车 的 横 摆 角速度 ，rad/s; m 为 车 重 ， 
kg; 三 为 转动 惯量 ，kg'm?。 

如 图 7 所 示 ， 第 i 辆 车 的 动力 学 特性 可 以 写成 
如 下 形式 ， 其 中 ie A = {L，2，3，4}， 表 达 式 如 公 
式 (6) 所 示 。 


mil = mý + FU) + FI 


my. = -mx gll 十 FH + FH (6) 

Lj? = LFU - LFÜ 

车 辆 坐标 系 与 道路 坐标 系 转换 形式 如 公式 (7) 
Biz o 

XU zy. yg 

CN TR (7) 

YH = dg yl 


根据 魔术 公式 Pacejka 轮 胎 模 型 ， 轮胎 的 受 力 
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在 侧 偏 角 和 滑动 率 比 较 小 时 能 够 用 线性 函数 近似 表 
达 ， 当 横向 加 速度 a, < 0.4g、 轮 胎 侧 偏 角 a < 5° 时 
对 轮胎 的 拟 合 精度 较 高 。 其 侧 向 力 的 表达 式 如 公 
st (8) 所 示 。 

F y = c/B; 

Fi) - cfi, 

式 中 : cj 和 ,分 别 为 前 后 轮 的 侧 偏 刚度 ，N/rad; 
Bj 和 PB, 分 别 为 前 后 轮 的 侧 偏 角 和 ，rad。 

最 后 ， 车 辆 的 动力 学 可 以 表示 成 公式 (9)。 


(8) 


cM) = f [en), un) (9) 
状态 向 量 如 公式 (10). 所 示 。 
él = [ x gl gil y" xU T (10) 


式 中 : 因为 道路 坐标 系 下 横向 速度 m/s; xU 
为 道路 坐标 系 下 纵向 速度 ，m/s; o! Ait il fü, 
rad; o WREE, rad/s; YAR ALL, m; 
XU SAIS EL, m. 

3 车 辆 编队 控制 器 设计 
3.1 线性 调节 跟踪 器 设计 

本 节 聚 焦 于 归 库 过 程 中 车 辆 在 车 道 变 换 时 的 跟 
踪 控 制 ， 基 于 线性 二 次 型 调节 器 (Linear Quadratic 
Regulator, LQR) ， 建 立 跟踪 误差 的 状态 空间 模型 。 
LJ fii] A te AAR SUR AS sty A eR, SET OL RBG 
NBM, WIT A te ERG] NIRE B Be AR AS c XB 
MK, ep, CREA 和 B， 如 公式 (11) 和 公 
式 (12) 所 示 。 


0 1 0 0 
4 Gti) CHC, Lc, les 
mv, m mv, 
A= id s (11) 
0 0 0 1 
jj Lebe, -letl =l e l 
Tv. I. Lv... 
| 0 
Cr 
m 
B = 12 
0 (12) 
lc, 
I. 


式 中 : cj、c, 分 别 为 前 轮 和 后 轮 车 辆 侧 偏 刚度 ， 
N/rad; 4、1, 分 别 为 前 后 轮轴 距 ，m; 7 为 车 子 绕 Z 
轴 旋 转 的 转动 惯量 ，kg'm:。 则 最 优 状态 反馈 矩阵 
KK 如 公式 (13) 所 示 。 


0 
ya e, Lc,- le, 
é, my, 
K=| ™|=A| > |+Bo+ @ (13) 
0 e: 0 
à) lë “I7¢,-17¢, 
Ivy, 


目标 函数 如 公式 (14) 所 示 。 
J= SU x (Ue) Ox(k) + 天 (DR5CGD] (14) 


当 目 标 函 数 最 小 得 到 最 优 的 状态 反馈 矩阵 如 公 
st (15) 所 示 。 

K-(R-«B,PB,y)' B,'PA (15) 

P 为 黎 卡 提 方 程 的 解 或 代价 函数 的 解 ， 用 以 稀 
量 系统 性 能 和 控制 代价 ， 如 公式 (16) 所 示 。 

P=A'PA-A'PB,(R+B,'PB,)'B,"PA+Q(16) 
3.2 延 时 补偿 控制 器 设计 

模型 预测 控制 (Model Predictive Control， 
MPC) 其 包含 自 适应 控制 、 内 模 控 制 等 多 种 方法 ， 
其 具有 变量 交互 、 处 理 约束 等 优势 使 其 工业 中 占有 
率 在 逐步 提高 。 随 着 机 械 智 能 化 发 展 ，MPC 逐渐 
广泛 应 用 于 无 人 机 和 机 器 人 等 控制 领域 。1986 年 ， 
Kuntze 等” 提出 了 以 内 部 模型 、 轨 迹 参 考 和 控制 
算法 为 核心 的 预测 控制 算法 基本 原理 。 至 今 ， 模 型 
预测 控制 的 主要 3 个 部 分 已 经 发 展 成 为 模型 预测 、 
滚动 优化 和 校正 反馈 。 

如 图 8 所 示 ，MPC 控 制 器 在 整个 过 程 中 始终 还 
有 参考 轨迹 。 通 过 融合 当前 值 与 预测 模型 对 预测 时 
域内 [类 ke ;| 的 系统 输出 进行 预测 。 基 于 对 目标 
函数 的 求解 ， 并 通过 约束 优化 可 得 到 控制 时 域内 
[k, k+ .| 的 控制 序列 。 受 控 对 象 的 实际 控制 量 为 
Kk 时 刻 ， 对 K+ 1 时 刻 不 断 进行 深 动 优化 以 实现 受 控 
对 象 的 鲁 棒 性 控制 。 


, —— -. 
Be 。 参考 轨迹 
pem] a Na —— ANA 
E acci 4 . 测量 输出 3 
| 和 一 一 F = 一 a 预 测控 制 量 4 
i $-—— — — 已 执行 控制 量 5 
Al, Pi LD ai 
: 预测 时 域 
m - 
| | | | | : | es ae 
| | | | | 
> 
采样 时 间 
k k+l k+2 et k+N, 


图 8 MPC 控 制 器 原理 
Fig. 8 Principle of MPC controller 
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3.2.1 线性 化 与 离散 化 

农机 动力 学 模型 和 运动 学 模型 均 为 非 线 性 系 
统 。 为 了 实现 高 精度 实时 控制 ， 需 对 模型 进行 线性 
变化 。 对 其 模型 在 1 时 刻 动力 学 方程 进行 线性 化 后 
ALEG), lr) ] 处 泰勒 展开 式 高 阶 项 ， 可 得 公 
式 (17)。 

E(1) =f [č (t), ut)] 


sae dle C= S(t) (17) 


十 


of 
ag 
dE souu plut) 7 u(t- 1)] 
对 其 进行 线性 化 、 离 散 化 ， 如 公式 (18) 所 示 。 
cmO(KE+1) = (k + 1) 
eA eC) - 8g] (18) 
+B Tul (k) - a (K)] 
整理 得 公式 (19). 
E(k +1) = AEU (k) + Bu (k) 4 d (Kk) 
(19) 
3.2.2 ”预测 模型 

基于 自动 驾驶 中 CAN 总 线 与 执行 器 存在 的 通 
信 延 时 ， 设 计 了 含有 认为 延 时 补偿 的 MPC 控制 
器 。 以 控制 量 增 量 作为 输入 可 得 新 状态 方程 ， 如 
公式 (20) 所 示 。 

E(k + 1) = AGO SP (O + 

B'\(k) Q Uk) + d"(k) (20) 

y(k) = C" (oS (k) 

以 预测 时 域内 的 预测 输出 与 轨迹 规划 参考 规划 
误差 作为 目标 函数 ， 则 农机 状态 向 量 如 公式 (21) 
所 示 。 

p Dy", XEL, o", y xu) (21) 
整理 得 公式 (22). 

&U(k + Uk) = AV (k) (k) + 
Bk) AU (Kk) + d" (k) (22) 
y" (k) = C? (Kk) (k + Ik) 

RP: N. 表 示 控 制 时 域 ，N, 表 示 预 测 时 域 ， 
N,« N,， 其 中 ,上 为 系统 预测 模型 在 k 时 刻 进行 预 
测 ; Ek + 1|k) 为 系统 在 k 时 刻 预测 k+ 1 时 刻 的 
增 广 矩 阵 状 态 。 

AW(K) 为 子 系统 i 在 时 刻 k 的 状态 转移 矩阵 。 
E11() 为 子 系统 i 在 时 刻 的 状态 向 量 ; BU CO) ONE 
系统 ;在 时 刻 上 的 控制 输入 矩阵 ;4UD(CK ) 为 子 系统 
i 在 时 刻 的 控制 输入 增 量 ; dU (Ke) V T AR LEE TN 


pe ox 


A KAS PETE sy! CO 为 子 系统 ;在 时 刻 k 的 
输出 向 量 ; CW(k) 为 子 系 统 i 在 时 刻 k 的 输出 矩阵 。 
3.2.3 目标 函数 

为 了 实现 农机 的 鲁 棒 性 轨迹 跟踪 控制 ， 通 过 对 
状态 量 、 状 态 增 量 和 参考 偏差 进行 优化 后 ， 可 得 到 
鲁 棒 性 轨迹 跟踪 控制 器 目标 函数 ， 如 公式 (23) 
所 示 。 

100 = ILE Gc jOE Ck + jk) + 


ü (k+j-1)Rù)(k+j-1) (23) 
式 中 : J(k) 用 于 评估 在 时 刻 k 的 控制 策略 ，j 
未 来 预测 的 时 间 步 长 索引 ; 0 为 状态 量 权 重 和 矩阵 ; 
RAPE lA EF 
3.2.4 约束 函数 
由 于 车 辆 自身 存在 操作 量 的 物理 约束 ， 因 此 设 
计 如 公式 (24) 的 控制 量 与 控制 增 量 的 相应 约束 。 
a (24) 
k=0,1,2,---,Ne-1 
WP, U (Kk + EWEA + t) RECA Ta dil d 
入 的 最 小 约束 值 ; Du(K + EWAN +) 系统 的 
控制 输入 的 最 大 约束 值 ; Uk + D) ITZ (Kk +t) 
系统 的 控制 输入 。 
其 中 ,增益 的 约束 如 公式 (25) 所 示 。 
AU i(k +t) & AUP(K +1) & AU, (Kk +t) 
k=0,1,2,---,Nce-1 
SUH, AU i(k + EO) WIN AI (Kk + 7 系统 的 控制 
fip ATE EE RR NZD E SAU, LK + t) IAI (k + 
1) 系 统 的 控制 输入 增 量 的 最 大 约束 值 ; AUU(K + t) 
为 时 刻 (k+ 1) 系统 的 控制 输入 增 量 ， 即 AUI(k+ 
th= UUk + t) - Uk+t- 1). 


4 基于 Carsim #0 Simulink 的 联合 仿 
真实 验 


4.1 联合 仿真 平台 搭建 


Carsim 是 由 车 辆 动力 学 仿真 软件 开发 公司 
MSC 开发 的 专业 软件 ， 能 够 对 SUV、 轻 型 货车 和 
私家 车 等 车 辆 的 操纵 稳定 性 、 制 动 性 和 燃油 经 济 性 
等 进行 分 析 ， 可 以 仿真 路 面 和 空气 阻力 等 外 在 要 素 
对 汽车 行驶 的 影响 。Carsim 具 有 界面 设置 友好 ， 方 
便 使 用 的 优势 。 

基于 实 车 的 自动 驾驶 算法 测试 与 优化 需 投 入 过 
多 时 间 、 经 济 成 本 ， 且 受到 法 律 法 规 、 场 景 复 现 以 
及 安全 性 等 多 方面 困难 ， 仿 真 平台 测试 可 以 有 效 解 


(25) 


Vol. 6, No. 3 


栾 世 杰 等 : 基于 MPC 延 时 补偿 器 的 农机 多 机 器 人 编队 行驶 轨迹 跟踪 方法 25 


决 所 有 痛 点 。 表 2 展示 了 在 使 用 Carsim 仿 真 过 程 中 
的 车 辆 动力 学 相关 参数 设置 。 

表 2 编队 行驶 农机 单机 动力 学 相关 参数 
Table 2 Relevant parameters of single machine dynamics for 


formation running agricultural machinery 


参数 符号 物理 意义 数值 
C, 前 轮 侧 偏 刚度 61 135 N/rad 
C,, 后 轮 侧 偏 刚度 61 135 N/rad 
m 整 车 质量 1 465 kg 
i 前 轴 距 12m 
L, 后 轴 距 1.6 m 


Carsim 与 MATLAB/Simulink 可 以 有 效 兼 容 ， 
实现 软件 与 外 部 求解 器 的 联合 仿真 。 多 车 编队 协作 
结构 流程 图 如 图 9 所 示 。 


参数 初始 化 


多 车 状态 信息 流 


V2X 

通 车 gods “ine 

讯 M | 千 载 轨迹 规划 模块 | 

的 yt Y 

= a [UD 

EIN B 

& Ik | 数据 分 发 | 

¥ * 

ži LQR & MPC | LQR & MPC | LQR & MPC 
} $ * 

Carsim Vehiclel | Vehicle2 [ Vehicle3 


图 9 多 车 编队 协作 结构 流程 图 


Fig. 9 Flowchart of multi-vehicle convoy collaboration structure 


Simulink 中 将 传感器 监测 到 的 速度 、 位 置 、 偏 
向 角 进 行 反馈 ， 用 以 调节 后 车 的 节气 门 开 度 、 油 
门 、 制 动 器 、 加 速度 、 转 向 角 等 执行 器 参数 。 基 于 
轨迹 跟踪 算法 输出 控制 信号 作为 Carsim 车 辆 模型 输 
入 信和 号， 控制 系 统 对 后 车 的 防 撞 、 变 道 和 跟随 进行 
控制 ， 实 现 鲁 棒 性 安全 跟随 控制 。 
4.2 控制 器 参数 设置 


4.2.1 速度 变换 器 

位 置 变换 器 是 车 辆 操控 系统 的 输入 环节 ， 其 主 
要 作用 是 把 操纵 杆 位 置 变换 为 相应 速度 。 模 型 如 公 
式 (26) 所 示 。 

v = 30x + 50, x e [0,1] (26) 

XB: x 为 操纵 杆 位 置 ; v 为 与 其 匹配 的 速 


E, m/s, 


4.2.2 ”离散 行驶 控制 器 

速度 控制 需 是 车 辆 操控 系统 最 重要 的 机 构 ， 它 
的 作用 是 根据 车 辆 速度 与 设置 速度 之 差 控制 发 动机 
输出 牵引 力 。 传 统 的 PID 控制 器 的 数学 表达 式 可 以 
写成 如 下 形式 。 

积分 环节 如 公式 (27) 所 示 。 


x(t)=x(t-1)+u(t) (27) 
微分 环节 如 公式 (28) 所 示 。 
d(t)=u(t)- u(t- 1) (28) 
系统 输出 如 公式 (29) 所 示 。 
y(t) = K,u(t) + K,x(t) + K,d(t) (29) 


式 中 : u(1) 为 系统 输入 ; ya) 为 系统 输出 ; 
x(1) 为 系统 中 车 辆 状态 。PID 控制 器 相应 的 控制 参 
数 分 别 为 玉 CUI). K, (积分) 和 K,( 微 分 )。 
4.2.3 ”车 辆 动力 机 构 

车 辆 的 发 动机 提供 行驶 的 动力 ， 其 在 车 辆 操控 
系统 的 控制 下 输出 相应 的 牵引 力 来 改变 车 辆 的 速 
度 ， 使 得 车 辆 的 速度 达到 设 定 值 ， 其 关系 表达 如 公 
式 (30) 所 示 。 

F = my + bv (30) 

XB: vy 为 车 辆 速度 ，m/s; 下 为 车 辆 的 牵引 
力 ，N; m 为 车 重 ，1 465 kg; 设置 阻力 因子 b 
为 20。 

4.2.4 单车 控制 器 参数 设置 

车 辆 的 控制 单元 和 底层 的 执行 器 之 间 的 通信 是 
通过 CAN 总 线 的 传递 ， 而 信息 的 传递 会 产生 延 时 。 
针对 单车 执行 单元 到 底层 执行 器 之 间 通 信和 恒定 时 不 
变 延 时 控制 ， 而 对 时 变 延 时 不 探讨 。 当 最 大 延 时 为 
t 在 采样 时 间 T 时 ， 延 时 步 长 在 离散 系统 中 的 表示 
如 公式 (31) 所 示 。 


Tin 
dnd 


图 10 展 示 了 带 有 控制 量 输入 固定 延 时 的 系统 。 
本 节 将 最 大 延 时 的 离散 线性 系统 描述 为 公式 (32), 
以 表示 单一 农机 的 运动 状态 。 

Xp.) = Áx, + Bau, (32) 

从 车 辆 CAN 总 线 到 执行 器 整个 过 程 中 都 伴随 
着 延 时 ， 过 大 的 输入 量 延 时 可 能 会 使 得 车 辆 的 稳定 
性 得 不 到 保障 ， 可 能 会 产生 严重 的 后 果 。 

轨迹 跟踪 控制 器 的 预测 时 域 为 N, = 40， 控 制 
时 域 为 N. = 20， 采 样 周期 为 T= 0.01s。 要 对 0 
(状态 量 ) MR (控制 量 ) 权重 矩阵 和 松弛 因子 


设置 。 


(31) 
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图 10 控制 量 输入 固定 延 时 系统 结构 图 
Fig. 10 Fixed delay System for control input 


10 0 0 " 

o- 10° vies ohe = 1000 
0 0 10 

XB: 0 中 参考 量 和 预测 量 误差 分 别 为 


YU. euh. vols 下 中 纵向 加 速度 和 转角 分 别 对 应 
ye, Gt, 
车 辆 前 轮转 角 约 束 为 : 


-25° < 6 < 25° 

AP: 车 辆 方向盘 右 转 为 负 ; 方向 盘 左 转 
为 正 。 

车 辆 前 轮转 角 增 量 为 : 

-0.48° < Aó < 0.48? 

车 辆 控制 量 约束 条 件 为 : 

Ey P ES 

-25 25 

式 中 : 车 辆 速度 和 期 望 速度 差 值 为 +0.3 m/s; 
车 辆 前 轮转 角 为 +25°。 

车 辆 控制 增 量 约束 条 件 为 : 

-0.05 0.05 

PARGA 

式 中 : 控制 周期 速度 增 量 为 上 0.05 m/s; 车 辆 前 
轮转 角 增 量 为 上 0.48。。 
5 基于 MPC 延 时 补偿 器 轨迹 跟踪 

仿真 

本 节 专 注 于 探讨 车 载 控 制 絮 到 执行 器 之 间 的 通 
信 延 时 对 车 辆 控制 系统 性 能 的 有 影响。 对 比 了 应 用 和 
未 应 用 延 时 补偿 机 制 的 MPC。 


5.1 延 时 步 长 q=5 
通过 人 为 设 定 的 最 大 延 时 r, = 0.05s， 计 算 了 


相应 的 延 时 步 长 4， 其 计算 方式 如 公式 (33) 所 示 。 


Tin pr 
4= 人 =5 (33) 


式 中 : 7 为 延 时 周期 。 

当 d=5 时 ， 实 验 结果 如 图 11 所 示 ， 应 用 延 时 补 
偿 的 MPC 反 应 速度 更 快 ， 表 现 更 为 平滑 ; 未 应 用 
延 时 补偿 的 MPC 速度 表现 出 显著 的 超 调 现象 ， 反 
应 速度 缓慢 ， 并 且 出 现 了 振荡 不 收敛 的 现象 。 


一 -一 采用 延 时 补 傍 控制 癌 车 辆 速度 
—— à SUM ME rp 28 4r 
Mut 6-6 


All 延 时 步 长 d=5 时 农机 采用 与 未 采用 延 时 补偿 控制 器 
情况 
Fig. 11 Graph of velocity comparison results between with 
and without MPC model when d=5 


进一步 地 ， 在 图 12 中 展示 了 速度 误差 和 纵向 
加 速度 的 比较 。 从 速度 误差 方面 来 看 ， 应 用 了 延 时 
补偿 的 MPC 响 应 更 快 ， 且 能 够 逐渐 稳定 至 零 误 差 ， 
没有 出 现 振荡 现象 ;而 未 应 用 延 时 补偿 的 MPC 响 
应 缓慢 ， 出 现 了 振荡 不 收敛 的 问题 ， 导 致 车 辆 容易 
出 现 急 加 速 或 急 减速 的 情况 。 

还 研究 了 1 号 车 在 延 时 步 长 4 = 5 时 的 轨迹 表 
现 ， 如 图 13 所 示 。 未 应 用 延 时 补偿 时 ，1 号 车 的 响 
应 速度 较 慢 ， 跟 踪 轨 迹 出 现 了 明显 的 振荡 。 当 应 用 
延 时 补偿 时 ， 结 果 如 图 14 所 示 。1 号 车 能 够 在 较 短 
时 间 内 有 效 地 变更 车 道 ， 与 头 车 保持 在 同一 车 道 
上 ， 展 示 了 延 时 补偿 在 改善 车 辆 跟踪 性 能 方面 的 有 
效 性 。 

5.2 延 时 步 长 o=10 


本 节 探 讨 更 长 延 时 步 长 对 车 载 控制 系统 性 能 的 
影响 。 设 定 的 延 时 值 加 大 至 r = 0.10s， 从 而 在 车 
载 控 制 器 到 执行 器 的 通信 过 程 中 引入 了 更 长 的 延 
时 。 根 据 此 设 定 ， 计 算得 到 新 的 延 时 步 长 4， 如 公 
式 (34) 所 示 。 


Tin = 
d= = 10 (34) 
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b. 纵向 加 速度 对 比 图 
图 12 延 时 步 长 d=5 时 ,农机 采用 与 未 采用 延 时 补偿 控制 器 
情况 下 的 速度 误差 及 纵向 加 速度 对 比 
Fig. 12 Velocity error and longitudinal acceleration comparison 


between with and without MPC model when d=5 


o-oo 


~ ~ 
N —O— vehicl 
9 \ -9— vehicle? 
N 一 6 一 vehiclel 
8 ® 3— vehicleL 


, 
hey 
3g 3 ; == 
0 100 200 300 400 500 600 700 800 
Xm 
注 :绿色 黑色、 红色 、 蓝 色 曲 线 分 别 为 头 车 1 号 车 .2 号 车 3 号 车 在 df 
=5 时 轨迹 曲线 。 


图 13 1 号 车 延 时 步 长 4=5 四 车 轨迹 曲线 
Fig. 13 Trajectory curves of four vehicles with delay step 
length d=5 for Vehicle 1 


延 时 步 长 d= 10 


city/(m/s) 


velo 


图 14 延 时 步 长 对 -10 时 农机 采用 与 未 采用 延 时 补偿 控制 器 
情况 下 速度 对 比 结果 图 
Fig. 14 Velocity comparison results graph between with and 
without MPC model when d=10 


实验 结果 显示 ， 在 更 长 的 延 时 步 长 4 = 10 人 情况 
下 ,未 应 用 延 时 补偿 的 控制 絮 表 现 出 更 显著 的 性 能 
下 降 。 具 体 来 说 ， 超 调 量 增 大 ， 响 应 速度 进一步 减 
慢 ， 且 存在 更 严重 的 振荡 不 收敛 现象 ， 如 图 14 
所 示 。 

此 外 ， 图 15 展 示 了 延 时 步 长 为 4=10 时 的 速度 
误差 和 纵向 加 速度 对 比 结果 。 结 果 表 明 ， 即 使 在 较 
高 的 延 时 条 件 下 ， 应 用 延 时 补偿 的 MPC 仍然 能 够 
快速 响应 并 逐渐 稳定 至 零 误 益 ， 避 免 了 振荡 现象 ， 
显示 其 在 保持 系统 稳定 性 和 提升 性 能 方面 的 有 效 
性 。 然 而 ， 未 应 用 延 时 补偿 的 控制 器 在 此 条 件 下 的 
性 能 显著 下 降 ， 反 映 在 响应 速度 缓慢 ， 存 在 不 收敛 
的 振荡 ， 导 致 车 辆 容易 发 生 急 加 速 或 急 减 速 。 

对 1 号 车 在 延 时 步 长 4=10 时 的 轨迹 进行 了 观 
察 ， 如 图 16 所 示 。 示 应 用 延 时 补偿 时 ，1 号 车 的 响 
应 速度 明显 变 慢 ， 且 振荡 幅度 大 于 延 时 步 长 d=5 W 
情况 。 相 比 之 下 ， 应 用 延 时 补偿 ，1 号 车 虽然 需要 
更 长 时 间 来 调整 车 道 以 与 头 车 保持 在 同一 车 道 ， 但 
仍 能 实现 此 目标 。 这 一 结果 表明 ， 尽 管 延 时 补偿 机 
制 在 更 高 的 延 时 步 长 下 仍 有 效 ， 但 其 效果 在 极端 延 
时 条 件 下 有 所 下 降 。 这 需要 在 设计 控制 系统 时 了 予以 
特别 考虑 。 

针对 车 辆 编队 中 存在 的 车 载 控 制 器 到 执行 器 之 
[E] AY CAN 通信 延 时 问题， 成 功 设 计 并 实施 了 一 种 
带 有 延 时 补偿 机 制 的 MPC。 通 过 在 不 同 设 定 延 时 
场景 下 对 比 应 用 延 时 补偿 和 未 应 用 延 时 补偿 的 
MPC 发 现 ， 带 有 延 时 补偿 的 MPC 能 够 有 效 地 弥补 
由 于 通信 延 时 导致 的 控制 性 能 下 降 。 相 较 于 未 加 入 
延 时 补偿 的 普通 MPC， 后 者 在 面 对 人 为 加 入 的 通 
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a. 速 度 误差 对 比 图 16 1 号 车 延 时 步 长 4= 10 的 4 车 轨迹 曲线 
延 时 步 长 4- 10 Fig. 16 Trajectory curves of four vehicles with delay step 
length d = 10 for Vehicle 1 


并 越 来 越 倾向 于 发 散 的 问题 。 特 别 是 在 轨迹 跟踪 控 
制 过 程 中 ， 随 着 延 时 步 长 的 增加 ,普通 MPC 的 性 
能 逐步 恶化 ， 表 现 为 更 大 的 振荡 幅度 和 更 慢 的 响应 
时 间 。 这 导致 了 横向 控制 上 的 显著 不 稳定 ， 表 现 为 
车 辆 在 行驶 过 程 中 频繁 地 左右 播 摆 。 在 纵向 控制 方 
面 ， 普 通 MPC 导致 了 车 辆 的 急 加 速 和 急 减 速 行为 ， 
增加 了 与 其 他 车 辆 发 生 碰 撞 的 风险 ， 同 时 也 影响 了 


Acceleration/(m/s?) 


Time/s 
b. 纵 向 加 速度 对 比 
图 15 延 时 步 长 4=10 时 农机 采用 与 未 采用 延 时 补偿 控制 器 
情况 下 的 速度 误差 及 纵向 加 速度 对 比 
Fig. 15 Comparison of velocity error and longitudinal accelera- 
tion between with and without MPC model when d =10 


信 延 时 ， 表 现 出 了 振 沪 幅 值 递增 、 响 应 速度 变 慢 ， 


乘客 的 驾 乘 舒适 性 。 相 比 之 下 ， 应 用 延 时 补偿 的 
MPC 在 这 些 方面 表现 出 明显 的 优势 ， 能 够 更 有 效 
地 控制 车 辆 ， 确 保 更 平稳 的 驾驶 体验 ， 同 时 减少 了 
发 生 交 通 事故 的 风险 (图 17 和 图 18)。 因 此 ， 本 研 
究 证 明 在 车 辆 编队 控制 系统 中 ， 引 入 延 时 补偿 机 制 
对 于 提高 系统 的 整体 性 能 和 安全 性 至 关 重 要 。 


10 Trajectories of vehicles 
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注 : 标 有 x 号 的 红色 线条 为 头 车 轨迹 曲线 ; 标 有 O 〇 的 黄色 、 红 色 、 蓝 色 曲 线 分 别 表 示 1 号 车 .2 号 车 .3 号 车 的 轨迹 曲线 。 
图 17 带 延 时 补偿 4 车 轨迹 曲线 (4=5) 


Fig. 17 Trajectory curves of a four-vehicle convoy with delay compensation (d =5 ) 


Trajectories of vehicles 
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注 : 标 有 x 号 的 红色 线条 为 头 车 轨迹 曲线 ; 标 有 O 〇 的 黄色 、 红 色 、 蓝 色 曲 线 分 别 表示 1 号 车 2 号 车 .3 号 车 的 轨迹 曲线 。 
图 18 带 延 时 补偿 4 车 轨迹 曲线 (d=10) 


Fig. 18 Trajectory curves of a four-vehicle convoy with delay compensation (d =10) 
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6 总 结 与 展望 

本 研究 基于 融合 LQR 与 MPC 的 控制 器 实现 了 
农机 装备 的 入 库 多 机 协同 归 库 过 程 中 的 编队 化 轨迹 
跟踪 ， 建 立 了 农机 单机 二 自由 度 动力 学 模型 和 运动 
学 模型 ， 为 之 后 农机 编队 行驶 问题 打下 基础 。 针 对 
实际 场景 中 车 载 控制 器 与 CAN 通信 延 时 而 产生 的 
横向 控制 精度 差 这 一 问题 ， 设 计 了 针对 不 同 工 况 下 
农机 装备 的 MPC 延 时 补偿 器 针对 编队 场景 编队 跟 
踪 算 法 ， 基 于 Carsim 和 Simulink 建立 农机 编队 作业 
的 联合 仿真 平台 测试 ， 实 现 多 台 农 机 编队 和 鲁 棒 的 协 
同 控制 ， 使 多 辆 车 辆 能 够 在 变 道 过 程 中 保持 定 距离 
和 定 速 度 的 轨迹 跟 踩 。 

目前 ， 多 机 编队 协同 大 多 基于 仿真 平台 进行 验 
证 ， 其 具有 安全 、 经 济 、 人 快捷 等 多 方面 优点 ， 然 而 
仿真 平台 中 理想 化 模型 与 真 机 实验 仍 存 在 一 定 差 
距 。 因 此 ， 农 机 装备 多 机 编队 作业 仍 需 要 进行 在 法 
律 法 规 健全 的 情况 下 进行 真 机 测试 。 此 外 ， 本 研究 
仅 考 虑 了 CAN 通信 的 不 变 延 时 ， 而 实际 场景 中 
CAN 通 信 延 时 还 受 网 络 传输 速度 、 通 信 信 号 等 因 
素 的 影响 。 因 此 ， 在 后 续 研 究 中 可 以 进一步 探讨 基 
于 CAN 通 信 时 变 延 时 的 补偿 方法 。 


利益 冲突 声明 : 本 研究 不 存在 研究 者 以 及 与 公 
研究 成 果 有 关 的 利益 冲突 。 
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Abstract: 
[Objective] The technology of multi-machine convoy driving has emerged as a focal point in the field of agricultural mechanization. 


By organizing multiple agricultural machinery units into convoys, unified control and collaborative operations can be achieved. This 
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not only enhances operational efficiency and reduces costs, but also minimizes human labor input, thereby maximizing the operational 
potential of agricultural machinery. In order to solve the problem of communication delay in cooperative control of multi-vehicle for- 
mation and its compensation strategy, the trajectory control method of multi-vehicle formation was proposed based on model predic- 
tive control (MPC) delay compensator. 

[Methods] The multi-vehicle formation cooperative control strategy was designed, which introduced the four-vehicle formation coop- 
erative scenario in three lanes, and then introduced the design of the multi-vehicle formation cooperative control architecture, which 
was respectively enough to establish the kinematics and dynamics model and equations of the agricultural machine model, and laied 
down a sturdy foundation for solving the formation following problem later. The testing and optimization of automatic driving algo- 
rithms based on real vehicles need to invest too much time and economic costs, and were subject to the difficulties of laws and regula- 
tions, scene reproduction and safety, etc. Simulation platform testing could effectively solve the above question. For the agricultural 
automatic driving multi-machine formation scenarios, the joint simulation platform Carsim and Simulink were used to simulate and 
validate the formation driving control of agricultural machines. Based on the single-machine dynamics model of the agricultural ma- 
chine, a delay compensation controller based on MPC was designed. Feedback correction first detected the actual output of the object 
and then corrected the model-based predicted output with the actual output and performed a new optimization. Based on the above 
model, the nonlinear system of kinematics and dynamics was linearized and discretized in order to ensure the real-time solution. The 
objective function was designed so that the agricultural machine tracks on the desired trajectory as much as possible. And because the 
operation range of the actuator was limited, the control increment and control volume were designed with corresponding constraints. 
Finally, the control increment constraints were solved based on the front wheel angle constraints, front wheel angle increments, and 
control volume constraints of the agricultural machine. 

[Results and Discussions] Carsim and MATLAB/Simulink could be effectively compatible, enabling joint simulation of software with 
external solvers. When the delay step size d=5 was applied with delay compensation, the MPC response was faster and smoother; the 
speed error curve responded faster and gradually stabilized to zero error without oscillations. Vehicle 1 effectively changed lanes in a 
short time and maintains the same lane as the lead vehicle. In the case of a longer delay step size d =10, controllers without delay com- 
pensation showed more significant performance degradation. Even under higher delay conditions, MPC with delay compensation ap- 
plied could still quickly respond with speed error and longitudinal acceleration gradually stabilizing to zero error, avoiding oscilla- 
tions. The trajectory of Vehicle 1 indicated that the effectiveness of the delay compensation mechanism decreased under extreme delay 
conditions. The simulation results validated the effectiveness of the proposed formation control algorithm, ensuring that multiple vehi- 
cles could successfully change lanes to form queues while maintaining specific distances and speeds. Furthermore, the communication 
delay compensation control algorithm enables vehicles with added delay to effectively complete formation tasks, achieving stable lon- 
gitudinal and lateral control. This confirmed the feasibility of the model predictive controller with delay compensation proposed. 
[Conclusions] At present, most of the multi-machine formation coordination is based on simulation platform for verification, which has 
the advantages of safety, economy, speed and other aspects, however, there's still a certain gap between the idealized model in the sim- 
ulation platform and the real machine experiment. Therefore, multi-machine formation operation of agricultural equipment still needs 
to be tested on real machines under sound laws and regulations. 


Key words: vehicle to everything; intelligent agricultural machinery; multi-machine collaboration; traveling in formation; trajectory 
tracking 
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